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Abstract 

In this paper, we have studied the control problem of target-point based path following for car-type 
vehicles. This special path following task arises from the needs of vision based guidance systems, where a 
given target-point located ahead of the vehicle, in the visual range of the camera, must follow a specified 
path. A solution to this problem is developed through a non linear transformation of the path following 
problem into a reference trajectory tracking problem, by modeling the target point as a virtual vehicle. 
Bounded feedback laws must be then used on the real vehicle's angular acceleration and the virtual vehicle's 
velocity, to achieve stability. The resulting controller is globally asymptotically stable with respect and the 
proof is demonstrated using Lyapunov based arguments and a bootstrap argument. The effectiveness of this 
controller has been illustrated through simulations. 

L Introduction 

In the field of autonomous vehicle guidance, navigation and control, path-following problem of car-type 
vehicles is of particular interest. Many contemporary researchers have published various techniques and 
strategies for this problem, such as [HI, [j2l, dH, 0, H. Among open-loop motion planning techniques, 
differential flatness approach has been significant in motion planning to drive vehicles on Cartesian paths 
0, [[HI. In feedback control techniques, larger effort has been made on tracking problems. A backstepping 
approach has been presented in the context of tracking in [9J. This approach has also been used in [ilOl . 
to develop a controller that is robust against vehicle skidding effects. Do et al. have further improved upon 
Jiang's backstepping method in ifTTI and [[T2l . by adding observers to render the controller output-feedback 
and extending it to tracking and stabilization for parking problems of a vehicle and introducing dynamic 
update laws to compensate for parametric uncertainty and modeling errors. In [T3l Aguiar et al. have used 
adaptive switched supervisory control combined with a non linear Lyapunov-based control to ensure the 
global convergence of the position tracking error to a small neighborhood of the origin. Bloch and Drakunov 
[[T4l have used sliding mode control for the stabilization and tracking of a nonholonomic dynamic system. 
This controller is global and ensures convergence to the neighborhood of the desired trajectory. Lee et al. 
[[TSl have proposed a saturated feedback controller for tracking of a unicycle-type vehicle, using its forward 
velocity and angular acceleration as control inputs. They have also extended this controller for application 
on car-type vehicles. 

The problem of path following differs from pure stabilization or tracking problems because the path, 
described by its curvature K"(.), is defined in space only, not in time. In this paper, we have addressed 
the path following control of a robot car-type vehicle using target point. This control problem arises from 
camera- vision applications [[T6ll , [[TTll . where the vehicle is guided by a target point ahead of the vehicle, 
within the visual range of the camera [[TSll . [[T6ll . The target point is fixed at a known distance d > from 
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the center of gravity on the axis of the vehicle. The control objective is to drive the vehicle, such that the 
target point follows the desired path (as shown in Fig. 1). This problem has been addressed in [19| where 
a local robust path following strategy has been proposed using target point. Their solution is based on an 
open loop control based on inversion of the nominal model, and a closed loop control for stabilization of 
the resultant system. The error dynamics have been expressed in the Frenet frame associated to the followed 
path. This technique, also discussed in EOl , is convenient only when the vehicle is close, positioned and 
oriented to the path. 

In our work, a global asymptotically stable controller is developed by parameterizing the path as a "virtual 
vehicle", which is tracked by the actual vehicle. In this way, the path following problem is converted into a 
tracking problem, with two control inputs: the angular acceleration of the real vehicle and the velocity of the 
virtual vehicle. The forward velocity control of the real vehicle is not considered as part of the navigation 
problem, as it is controlled by other intelligent control systems in practical applications (for example, ABS, 
ESP [1211 ). It is instead assumed to be a measured state that is strictly positive, meaning that the vehicle is 
in continuous forward motion. 

It can be noted that if there is no target point, i.e. d = 0, then the tracking error model obtained in this 
study is identical to [15], in which tracking has been achieved by using saturation on one control input 
while the other is unbounded. In our case, the introduction of the target point at a distance makes the 
dynamics of the tracking error model more complicated. Specifically, the development produces a first order 
nonlinear non-globally Lipschitz differential equation (see equation (|9])) that can blow up in finite time. To 
overcome this difficulty, our solution necessitates the application of saturated controls for both our control 
inputs with arbitrary small amplitude. Examples of application of saturated control can be found in [|22l . 
[|23l . [|24ll . [|25l. [|26l|. [27]. Consequently, if both the control inputs are applied on the real vehicle, then 
the path following problem developed here becomes equivalent to the generalization of [fTSll . as tracking 
problem with a target-point. 

This paper can be seen as the continuation of the authors' previous work in [28], in which a unicycle type 
vehicle had been considered. However, the arguments of the Lyapunov analysis used for the convergence 
proof are significantly more involved than that of ll28l . due to the added state of the car type vehicle 
(essentially an integrator) and the fact that one must keep track of the small amplitudes of the saturations. 
Therefore, a positive definite function V is designed instead of a global Lyapunov function, whose time 
derivative along the closed-loop system is strictly negative outside a neighborhood of the origin. The design 
of V relies on an asymptotic analysis of a Ricatti equation, which is not needed in [28]. The convergence 
to zero is then demonstrated using a bootstrap procedure ||29l , i.e., once the system errors converge to a 
neighborhood, they continue to diminish to a smaller neighborhood, and ultimately converge asymptotically 
to the origin. The results so obtained can be extended to the case where only the position of the reference 
trajectory is directly known. 

The paper is organized as follows: in Section 2, the vehicle model and reference trajectory parameterization 
have been presented. In Section 3, the control design has been discussed and the Lyapunov function has 
been developed. The stability analysis of the closed loop system has been discussed in Section 4. Simulation 
results have been provided in Section 5, and a conclusion has been presented in Section 6. 

II. Vehicle model and reference trajectory 

Let us consider a path F with geodesic curvature Kr whose absolute value is bounded by K,nax > 0, i.e., 
for all ? > 0, we have 

\Krit)\ < Knax- (1) 
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As described in the introduction, T will be parameterized as a vehicle trajectory with a forward velocity u{t) 
such that r{t) = {pr{t),qr{t)) is described by the following state equations 




u cos 1//^, 

(2) 



u sini//^, 



14, l^y ^ 

= U Pr, 

where i//^ represents the angle between the abscissa axis and the velocity vector {pr.qrY , and Ky is the 
scalar curvature associated to the parametrization of Y by time t. The arclength 5 of F is given by s{t) — 

so+ u{x)dx and the scalar curvature Kr{t) is hence equal to K*{s{t)). 
Jo 

The state equations for the vehicle dynamics are 

= V, COS!//, 

= Vx sini//, 
= V^po. 

These equations represent the vehicle's motion with a velocity Vx, along the curve defined by the its geodesic 
curvature K. The control variable po will be defined later. Notice that Vx is not necessarily constant, but simply 
a continuous function of time, which verifies the following hypothesis: there exist two positive constants 
< Vmin < Vmax, such that for all ? > 

Vm,n < Vx{t) < V,nax. (4) 

The strict positivity of the lower bound is necessary to derive our subsequent results. Note that path following 
for a unicycle type of vehicle has been obtained under weaker hypotheses than that of the above equation, 
cf. in particular the persistent excitation condition (PEC) [30|. It is not clear to us how to extend the present 



work only assuming that Vx satisfies the PEC (see Remark ( |III.1[ )). 

e defined as 

(5) 



For the target point, the equations for the coordinates p and q are defined as 

p = x + dcosx}/, 
q = y + d s'mxif. 

We will also suppose throughout the paper that 
(HI) dK^ax< 1- 

Remark II.l. The above assumption may be considered as a technical one or a design constraint for 
positioning the target point. However, it is reasonable to upper bound the curvature of the reference path in 
terms of the distance d. Indeed, tracking a circle of radius d' <d with a point fixed at a distance d in front 



of a vehicle is impossible. To see that, one can see that intuitively of rely on equation ( [45] ) given below. At 
the ligth of the previous example. Hypothesis {HI) is almost optimal. 

The dynamics of the target point in a form similar to (|3]) can be obtained by deriving the precedent 
equations. One first gets that 

6 = COS!//- J V;, sini/A fc, 
q = Vx sinl/z + J Vx cosl/A fc, 

The curve defined by the target point is traveled at the following speed 

Vd = ^Jp^ + q^ = Vx\ll + {KdY. (7) 
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Fig. 1. The reference trajectory, the vehicle and its target point. 



Our objective now is to define the dynamics of the target point as those of a car. For that purpose, we 
consider as the angle between the abscissa axis and the velocity vector {p,qY . One easily gets that 

= V/ + arctan(K-J), (8) 

Q 

then p = v^cos(0), q = Vrfsin(0), and the scalar curvature a is defined by ft) = — . 

We define the dynamics of ft) by the new control variable p := (b/vd ■ Deriving equation ([8]), we obtain 

dk = V^{\ + {Kdf){{l + {Kdf)^I^O} - k). (9) 
Hence the dynamics of the target point {p^q) becomes 

P = Vd COS0, 

q = Vd sine, 

= Vrfft), ^'""^ 
ft) = Vd p. 

The error between the target point and the reference curve is defined as 

ep = P-Pr, 

1 = 

and the error dynamics is given by 



(12) 





V = 


CO - Kr. 


ep 


= Vd 


COS0 — MCOS l/A^, 


eg 


= Vd 


sin0 — Msini//^, 




= Vd 


ft) — M, 


^7 


= Vd 


P — Pr U. 
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III. Control design and Lyapunov Function 



In this section, we will present a control law u{ep,eq,t,,r\,t) and p{ep,eq,t,,r\,t), such that the system 
([T2]) is globally asymptotically stable (GAS for short) w.r.t. origin. Note that, from the equations (|7]) and (|9]), 



one recovers the control po once and p are determined. However, there is an issue of possible blow-up in 



finite time for K (and thus for po). Indeed, assuming that one is able to stabilize ( [T2| ) to zero, then the control 
po is obtained by derivating K, which is in turn obtained by solving (|9]), seen as an o.d.e. with unknown 
K since ft) tends to Ky asymptotically. Equation (|9]) is of the type k = f{Kj) with the right-hand side / 
not globally Lipschitz w.r.t. K, hence it is not immediate to insure global existence of K for all t >0. We 
will show later on, that an appropriate choice of u and p under Hypothesis (HI) solves this problem (see 
Lemma |IV.1| below). 



The standard saturation function o{x) defined for .x; G M by 



oix) = (13) 

max(l, \x\) 

Let us first of all perform a variable change on the control, as follows 

U = Vrf(l+Ml), 

p = pr{l+Ui)+U2, 

where wi, U2 are the new control variables. 

Remark III.l. In order to define CO, p and to perform the change of inputs variables, must be greater 
than zero and thus Vx must also be strictly positive. It is therefore not obvious to proceed as above, if Vx 
only satisfies (PEC). 

With the boundedness of K and Vx, equation ^ implies that Vd is bounded. If one insists on having p 
bounded, then we must assume also that pr is bounded, as 

\pr\ < Pr,max, (15) 

where pr,max is a known positive constant. 



The system ( |T2| ) is therefore rewritten as 

= V^/(cOS — cos l//^ — Ml COS l//^), 

(16) 



= Vrf(sin0 — sini//^— wisinv/^r), 



f] = VdU2. 

The bounded controls ui and U2 can be expressed in the following form: 

Ml = Cia(-), 
U2 = Da{-), 

with sufficiently small gains Ci and D. Since K is bounded, also remains uniformly bounded throughout 

t >0. We can hence change the time scale by considering ds = v^ dt. To keep the notations simple, we 

df 

would continue to use t for time, and the point for the derivation with respect to s, like — = /. This has no 

ds 

effect on the control laws since our design is based on static feedback (w.r.t. the error). The error dynamics 
hence becomes 

Cp = COS0 — cos 1//^ — MlCOSl/A^, 

eq = sin0-sinv/r-wisinv/^, 

t, = ri-KrUl, 
f] = U2. 
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Let us perform the following change of variable corresponding to a time-varying rotation in the frame of 
the reference trajectory 



yi 



The system becomes 



yi 
yi 



= Cp cos xi^r + eq sini/A,., 
= —ep s'mx^/r + eq COSl/A^. 

-Ml + (C0S(^ -1) + (1+Mi)k-^J2, 

sin^ - (1 +Mi)fC;.3;i, 

"2, 



(19) 



(20) 



where ui, will be chosen such that ( |20| ) becomes GAS. 
The control variables ui and U2 are defined as follows 



Ml 
U2 



Cio{yi 
-Do{ 



D 



i^ + |T] + :^a(j2)), 



D 



(21) 



where k\^k2,C\,C2,D axe- positive real numbers and a() is the standard saturation function defined in (13). 
Typically, we want to stabilize the system with arbitrarily small saturation levels Ci and D. In conclusion, 
the final system, noted (E) becomes 



yi 
yi 

^7 



-Cia(yi) + (cos<^ - 1) +jU3;2, 



D 



D 



D 



where 



^ := k:,(1 +C\o{yi)) and < K^ax{l +Ci] 



(22) 



(23) 



In the following section, it is shown that Global Asymptotic Stability of the system ( |22| ) can be achieved 
by proper selection of Ci, C2, k\, ^2- 

More precisely, we prove the following theorem, which is the main result of the paper. 

Theorem III.2. Consider a path T with geodesic curvature K* verifying ([T]) for some K^ax > 0- It is then 
possible to track asymptotically 7 with a point fixed at a distance d> in front of a vehicle, where dx^ax < 
1, ty choosing the control la«s^ according ,o gD wi* constants k,MQ,C2,D. «hich satisfy the 

following conditions. Set a := — . 



k\ = ak2 , C2 



1 



2/3^2 



Ci 



aC2 
4h' 



(24) 



where j8 is a positive constant larger than 8, D is an arbitrary positive constant, fixed a-priori, and ^2 is 

large enough that - — ^ 1. 

k2D 



Proof: The proof of GAS stability of System (22) has been carried out as an argument based on 
Lyapunov analysis. 
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(26) 



The first remark consists in focusing on the last two equations in (E) and we will first treat the case where 
there is no saturation on f]. 

In that case, the last two equations in the previous section define a double integrator system, which shall 
now be denoted as (Sk): 

K) 1^="^;", , (25) 

with, 

VI = -KrCia{yi) , 
V2 = -C2o{y2). 
The system (Sk) can be presented in the matrix form 

Z^AZ + BU, (27) 

where. 

Since A is Hurwitz, there exists a quadratic form Vk = Z P^Z, where Pk is a positive definite square matrix, 
obtained by solving the following Riccati equation 

p2 

PkA+A^Pk + ^ = -I, (29) 
where, is the L2-gain related to the system {Sk)- The derivative is given by the following equation 

% = -l|zf - + IZ^PkU, (30) 

and verifies 

Vk<-\\zf + Tl\\U\\^. (31) 



The Lyapunov function proposed for the global system (22) is 



2 2 

V = MVk + h^^^^^ + r]y2 + k2y2^: (32) 
where M, ki, k2 are positive constants to be chosen later in particular to ensure that V is positive definite 



function, see Lemma IIL6 below. Moreover, a straightforward computation yields the following: 



Proposition III.3. The derivative of the Lyapunov function can be upper bounded as follows, 



y < -M{^^ + ^^)-kiCiyia{yi)-C2y20{y2)+MTi^({KrCiC>{yi)f + {C20{y2)) 



+fciy2(sin^ - <^) +fci3;i(cos<^ - 1) - jUT]);i + 7] sin^ -k2y2KrC\0 {yi) -k2^^yi +k2^ sin^. 



(33) 



The rest of the argument is divided in two main steps. In the first step, the existence of appropriate 
constants M,k\,k2^Ci,C2 is proven, such that V has a positive definite quadratic form in all the variables. 
This means that there exists a bounded region Y^^ (for k2 typically large), in the (y 1,^2)— plane: 



8 



1-^2 = {(3^1.3^2)1 bi|<§, b2|<^}, (34) 



such that outside this region, the derivative of V along trajectories of (22) fulfills the following inequality 



V < -f + ^7^) - h yJiCT (ji) - ^y2a (3^2) • (35) 



In the second step, a bootstrap-type argument is applied to show the convergence of trajectories of ( [22| ) 
to zero, as t tends to infinity. 

These two steps have been achieved in the following manner: the L2-gain of (5^), denoted by is 
calculated, then i\ is estimated for ^2 tending to infinity. Then ISS (input-to- state) type bounds are calculated 
for ^ and rj and the derivative of the Lyapunov function is estimated outside Y^^, and the argument is 
concluded. The detailed calculations have been presented in the following subsections. 

A. Lj-gain Tl 



Let us study the system (Sk), defined in the equation ( [25| ). We recall that, (S^) can be presented in the 
following matrix form 



(36) 




3 7 

Lemma III.4. We will tune ^2 > 20 with ki = —ki, then 1 < < 1.2. 

16 ^ 



The proof of Lemma IIL4 is given in Appendix 



B. Estimation of for large kj 

7 3 

In this section, we take ki = ak2 with a = — and ^2 tending to infinity. We will prove the following two 

16 

results whose proofs are given in Appendix. 



Lemma IIL5. As kj tends to infinity, the positive define matrix Pk defined in ( [29| ) admits the following 
asymptotic expansion 

fpih P2\ 

with Pi = Fi{l -fO(^)), 1 < / < 3, where the Fj are positive constants (only depending on a) so that 

2 

FiF3-F^>0. 



Proposition IIL6. For k2 large enough and M = [5k2, the function V defined in ( [32] ) is a positive quadratic 
form in {^,ri,yi,y2). 
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C. ISS bounds for ^ and r\ 

For a real-valued continuous and bounded function / defined on 



we set 



and 



Lemma III.7. Consider the system (|i(5p. By tuning k\ 
following inequalities for t >Q, 



|/r(0 :=sup|/(.) 

s>t 



lim sup 1/(5)1 
3 
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the ISS bounds of t, and J] satisfy the 



\ri\*{t) <K^axCi + ^^C2+\\e^'Zo\ 



(38) 



where Zq is the initial condition. 
As a consequence, we have, for t >Q large enough. 



i^r(o < ^ u,„«.,ci + — C2 

32 

|T?r(0 <2K^axCl + —C2. 

3K2 



(39) 



The proof of the above lemma is given in Appendix. 

From the argument of Lemma IIL7 other ISS bounds for and 77 can simply be derived by considering 



the system {S^) defined in ( |25| ) with the controls Vi and V2 given in ([26]). 



Lemma III.8. Let (Sk) be the system defined in ( [25] ) with the controls Vi and V2 given in ([26]). Assume that 

\\yiT<K„,ax, \\y2\C <i. 



Then the bounds ( 39 ) can be improved as follows: there exists T > such that, for every t > T, 



i^rw ^I^{c,\y,r{t)+^^c2\y2r{t) 
\ri\%t) <2Ci|yir(o+^c2b2r(o- 



(40) 



Proof: The argument is straightforward by replacing Ci and C2, which were used to bound Vi and V2 



in ([63]) by K^axCi \yi\* (t) and C2 \y2 \*{t). ■ 
For the rest of the paper, we choose Ci,C2 << 1 so that the limsup of both ^ and rj are very small. In 

£2 

the subsequent computations, we can assume with no loss of generality that \cos^ — 1| < — , |sin(^| < \^\ 



and I sin (E — (E I < 

Proposition III.9. The following inequality holds true 

V < -M{^^ + r]^)-kiCiyio{yi)-C2y2C>{y2)+MTL'(^{KrCiaiyi)f + iC2o{y2)y 
_^kj\y2^ ^ kily^^^^y^ ^ I _ k^y^^^CiGiyi) - k2^m+k2^^. 



(41) 
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D. Estimation of V for y ^ Y^^ 

In this subsection, we choose the several parameters so that V verifies ([35]) outside the region Y^^, for 
large enough. The results are summarized in the next lemma. 



Lemma III.IO. For the choice of parameters defined in Theorem 111.2 there exists ki large enough and 
T > 0, such that, for every t > T, Eg. ([35]) is verified. 



The proof of Lemma III.IO is given in Appendix. 
In the rest of the paper, the symbol C has been used to represent arbitrary constants, depending only on j8. 

Remark IILll. Notice that inside Yj^^, the term k2\y\t, \ cannot be controlled since we only have for that 
purpose the term j5k2^^ + Cy\. 



E. Final step 

C , , C 

Note that outside Yi^^, for t large enough, V < — 4 • To see that, we proceed as before since either \yi \ > 

2 

c 



^2 



or 1^2! > "777 • ^ consequence, every trajectory of ([22]) must reach Yj^^ in finite time. Therefore, along 

2 

every trajectory of ( [22] ), the value of V is eventually smaller than Vmax, the maximal value of V over the set 



kj 



|t?||<-^, bl|<72' \y2\< 
2 



^2 



3/2- 



By using ( |68] ) and Lemmc III.7 , we get 



We deduce by using again (68) that, along every trajectory of (22) and for t large enough 



c 

k\ 



We can then use the improved ISS bounds for and 7] obtained in Lemma III.8 In particular, one gets that, 
for t large enough. 



c 



^3+3/2' 



\r]\\t)< 



C 



2+2, /2'- 



In turn, this new bound for t, allows one to shrink the bounded region Y]^^ outside which V verifies ([35]). 

„ „ , , C , , C 

Indeed, one has to satisfy either (66) or (67), which leads to either \yi \ > , or |j2| > — 



^2 



Continuing the procedure described before, we construct inductively four sequences of positives numbers 
yi,n, y2,n, and T]„, H > 0, of uppcr bounds of ||ji||*, 11^211*, ||<^ H* and ||t]||* respectively, such that the 
following inequalities are verified 

e ^ ^ y\,n+y2,n ,„Jl,n+j2,n 
b'l — ^ , T 1 'In _ ^ 



^2 



^2 



which are obtained from (40), and 



yi,n+i < c^n, yl^+i < ckl^nyi, 
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which are, according to ([66]) and ([67]), the equations needed to define, at the {n+ l)-th step, the bounded 

that, for all 

yi,n+i+y2,n+i < -7={yi,n+y2,n)- 



region outside which V verifies ([35). It is simple to prove that, for all non negative integer n, we have 

C 



k2 

This immediately yields the convergence to zero of trajectories of ( [22] ). 

Remark III.12. The bootstrap procedure we have used above is clearly an instance of a small gain theorem. 



IV. Stabilization of the original system 



We have stabilized System ([22]) in case there is no saturation on i]. We will now show that for every 
initial condition, the term inside the outer saturation in i] becomes bounded by 1 for t sufficiently large (i.e. 
there exists T > such that, for t > T, the thesis holds true). Thus the last two equations of ([22]) are given 
by ( [25] ). To show that, we need an ISS-type of result on the system 



(Sk) 



ri+Cidu 



(42) 



where di and d2 are amplitude-bounded perturbations which amplitudes are bounded by constants eventually 
depending on K^ax- We first perform the linear change of variable defined by 



ki ^Mt. 



Y{t) 



A direct computation shows that the dynamics of {X,Y) is given by 

X^Y + '-^d,, 



(43) 



Since both and — are of the magnitude of , 

D D ^ kiD 



these constants can be chosen arbitrarily small. Then, 



as a consequence of Theorems 2.5 and 2.6 in [|3ll1 . one gets that there exists C{a) > a positive constant 
only depending on a so that 



limsup(|X(0| + 17(0)1 < ^(ll^i||oc + 11^211.). 

f^oo K2IJ 

Ci 1 

Therefore, \X{t) + Yit)^ d2{t) \ becomes strictly less than one for t large enough if - — 

D K2D 



(44) 

is small enough. 



The following lemma provides bounding conditions on u\ and U2 that would guarantee that the differential 
equation given in ([9]) is defined for all times t >0. 

Lemma IV.l. For k2D large enough, the differential equation in K given by ([9]) is defined for all times t >0. 
Proof of Lemma IV.l] After multiplying (]9]) by K, one can rewrite as follows. 



dKK 



(1 + (^/k:)2)3/2 



\k\Vx 



sign{K)dri + (1 



d\K\ 



+ {dKrSign{K) - V 



(45) 
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The right-hand side of the above inequality is majored by 

\K\V^{d\ri\+dKmax-'i-+ ^ 



1 + (Jk)2^' 
If we can ensure that 

d\\r]\\^ < I - dK,nax, (46) 



then this will easily imply that K does not blow up in finite time. Indeed, assuming that ( [46] ) holds, then 
there exists ^ > (only depending on ^i?||T]||co and dK^ax) such that the right-hand side of (45]) becomes 
negative for \k\ > K. This readily yields that l^l becomes strictly less than K in finite time and therefore 
does not blow up in finite time. 



We now show that ( ]46] ) holds true with an appropriate choice of the constants ^1,^2- Without loss of 
generality we can assume that ^(0) = T](0) = 0. In that case, one can replace the lim sup's in the left-hand 

1 



side of (44) by ||X||oo + \\Y\\o^. Since can be chosen arbitrarily small, (46) follows. - 

k2D 

Remark IV.2. The proposed method appears to require global localization of the mobile robot and the 
desired trajectory at every sampling instant with respect to the world frame, which is usually very difficult to 
obtain in real applications. However, this does not restrict or limit the application of the presented controller 
in real life. For example, the position coordinates in (x, y) frame of reference can be obtained by a camera 
and the angle \j/ ( the direction of vehicle ) by a gyroscope. The position of the target point can then be 
translated into (p,q) frame of reference given in Equation (5). From here, a finite time differentiator can be 
used to get p,q, and later on the angle 6. A simple exponential (even homogeneous finite time) observer 
can be used to get rj as in / |32]/ . 

Remark IV.3. Since the proof of the convergence is using a Lyapunov function which is strict outside Yj^^, 



the results of Theorem 111.2 can easily be extended in case where we have only direct access to {pr{-),qr{-)). 



Note that the gradient of the Lyapunov function is linear in its argument and thus, if the states are obtained 



through observers of differentiators, this will require Ci, i = 1,2 in p5\ to be changed with Ci + fit), where 
fi{-) is the observation or estimation error. There exist fixed time convergent differentiators such as / 133]/ . 
which ensure that the derivative converges in fixed finite time. On the other hand, if the estimation or 
convergence is asymptotic, it has been shown in / J/1/. / 132|/ that if f\ , /2 tend to zero exponentially, then the 
controller will also converge and the proof will not change. 

V. Simulations 

The performance of the presented controller can be seen in the simulation results obtained using the 
following parameters: 

d = 2 m, Vx = 5 m.s^^ . 

dKmax has been chosen much smaller than 1 in order to emphasize upon significant initial conditions 
(in particular, (§(0) close to n) so that the resultant illustrations highlight our claim. The initial conditions 
imposed upon the error are 

ep(0) = e,(0) = 10 m, <^(0)=9;r/10, 
The parameters of the controller was taken as follow: 

Ci =0.1172, C2 = 0.5, A:i=7500, A:2 = 200, D = 5Q. 
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Figure [2] shows the reference trajectory, the target point and vehicle in a 2D coordinate plane. It can be 
seen that the system converges to the reference trajectory asymptotically. Once the vehicle converges, the 
target point and the vehicle follow the trajectory very closely. The convergence can also be seen in the error 
graph shown in figure [3| where the initial conditions are also visible. 

Figures |4] and [5] show the control signals u and p respectively. It is clear from these figures that the 
controller does not attain extremely large values, and is bounded. This is an essential property in real 
systems, which does not result in impossible control signals when the initial error is very large. 



VI. Conclusion 

In this paper, we have addressed the problem of path following using a target point rigidly attached to 
a car type vehicle, by controlling only the orientation of the vehicle by its angular acceleration. The main 
idea was to determine a control law using saturation which ensures global stabilization in two steps. The 
proposed Lyapunov function forces the errors to enter a neighborhood of the origin in finite time. The 
Lyapunov analysis also shows that by a bootstrap procedure, this neighborhood contracts asymptotically to 
zero. Simulation results illustrate the GAS performance of the controller. 
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Fig. 2. Reference trajectory, of the vehicle and its target point 
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Fig. 4. Control u 



Fig. 5. Control p 
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A. Proof of Lemma 111.4 
One has 



VII. Proof of technical lemmas 



v-l 



Gis) = isl2-Ay 
and the L2-gain is defined by 

where a is the largest singular value of G{jco). Since 

S{co) := G{j(0)G*{j(0) = (0^h + jco (A-A^) +A^A, 

one has that Tl^ is the inverse of the smallest eigenvalue of S{co). 
We start the calculation of the matrix S{co) and get 



kik2 - jO){l+ki) 



kik2 + jCO{\ +ki) 
l+kl + Q}^ 
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The minimum eigenvalue is equal to 



\+kj + kl + 2(o'^- J{l+kl+kl + 2co^)^ -A(^(0^kl + {(0^-kiy 



(50) 



The minimum of A„,/„ with respect to CO is equal to 



^ _ l+kl + kj l {l-k\f + kl{kl + 2 + 2k\) 



We deduce that 



2k2,, , f2{l+kl)^2 



(51) 



(52) 



If we tune ki = — kj and k2 > 20, then 0.93 < A„„„ < 1, and 1 < < 1.2. 
16 



B. Proof of Lemma III. 5 



In that case, and by using the Taylor expansion of equation (52), we have the following asymptotic 
expansion of T|^, 



1 + 



1 



1 



2a^kl^ 2a^k\'^^^k^^' 



Then, the Riccati equation proposed in ( |29| ) takes the following form 

+T^A)^ +TtA) = S, where S = -Z + xiA^A. 
It can easily be checked that S is definite positive since det(5) > 0: 

S = 

and we get: 



(53) 



(54) 



-l+Tla^k^ 
Tlakl 



Jlakl 



-l+jl{l + kl) 



det(5) = Tlkjia^kliTl - 1) - 1) - (Tf - 1), 



and we deduce from ( p2[ ) the following Taylor expansion for det(5), 

det(5) = 1x1^1(1 + 1 + 0(1)). 



Then, the Riccati equation ([54]), takes the form: 



X'X=S, 



where X = — +TlA, and the solution is: 



X = -^+TlA = R^Vs, 



(55) 



where i?^ is a rotation of angle ^ and is the unique symmetric positive definite matrix whose square is 
equal to S. We first estimate and then 0. 



We clearly have 



where ^ — '^j'^2=(^l and 



S = bb^ + ye2el, 



The asymptotic expansions of the above quantities are 



7 = 



det(5) 



1 1 



We also need the asymptotic expansions of the eigenvalues of S. Since 



s = 



aj8 j8^ + r 



then. 



-^1.2 = 



We immediately deduce the following asymptotic expansions for the eigenvalues of S, 



^2 



We use b to denote the unit vector b/\\b\\ and define the angle <j>h so that R^i,ei = b, where 
We have 



H|=T,a/:i(l + -l-^ + 0(l)), 



and 



= l2ld2 + hAo, 



where Aq = ( ^ qM and 



^2 

We then get that R-^^e2 = /2e2 — h^i- We can therefore write 



and deduce that 



= (ll^f +r^?)ei4 + r^2^^24-r^i^2(ei4+e2e[). 
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Finally, we seek a formula of the type 

= sieiel + S2e2el - S3{eiel + e2el 
where the sj's are positive. A simple identification leads to the equations 



(58) 



S3 



rhh 

TriVS)' 



We deduce at once from the asymptotic expansions of the eigenvalues of S obtained in (56) that 



s, = \\b\\il + 0{^)), ,2 = ^7(1 + 0(1)), 



From the expression we obtain 



Ti^{l + akl) 



1 

-1 



Tr(Vs] sin(0) 



^3 = 0(1). 

«,2 



1 

-1 



and we deduce that Tl(1 -\-al^) = —Tr{\/S)sm{(j)), i.e. 



(59) 



1 



sin(<|,) = -(l--iL + 0(-3)), 

z,/C2 ^2 



where Co — . It implies that 



Co 



{l + 0{-))ld2-{l-^ + 0{^))Ao 



Iki 



We now collect the result of the equation ( [55) ) and ( |59| ) to get, 

Pk 



1 



-TlA + R^R^, ysieie\+S2e2el + ^^^^^ 



R . 



After a long but straightforward computation, we arrive at (37). 



C. Proof of Proposition 111.6 



Proof: The proof is developed using Young inequality, | < — h — , where £ is an arbitrary positive 
constant. 



First of all, according to Lemma III.5, for large k2, the quadratic form Vk{t,,r\) satisfies the following 
inequality 

y,(^,77) > F,k2e + 2F2^y]+F,'^- |(^2 ^ 



for some positive universal constant C > 0. Then, by setting X := a/^i^t? and Y :- 



1 



, we obtain 



y,(^,7])>(i-^)x2 + 2^^xy + (i-^)y2. 



^2 



^2 
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Since ^ 



F1F2 
a such that 



< 1, the above inequality ensures, for large enough, the existence of / > only dependent of 



The previous inequality with M = [ikj and ki = ak2 computed in ([30]) implies 



ak 



v(yi,y2,^,T?) > Wm^ + Wr + ^{yt+yi)-\iy2\-\k2y2^\ 

By using Young's inequality, we get 



k^t^ 1 v2 



Which implies. 



,'ak^ 1 \ 



Clk--) 



yi- 



then for large enough k2, V is a positive quadratic form in ((^,T],>'i,>'2). 



D. Proof of Lemma I II. 7 



The solution of the equation ( 27 1 is 

Z{t)= f e^^'-'^U{s)ds + e^'^, 
Jo 



(60) 



where Zq is the initial value of Z for t = 0. We start by diagonalization of the matrix A, whose eigenvalues 
are equal to 



X- 



k2 1 
■2+2 



2 +2V^2-4^i' 



(61) 



with corresponding eigenvectors 



1 



A. 



andy_ 



^ ] . From here, we obtain A = PDP ^ , where 



D 



We get 



(A_vi - V2) A^'-^') + (A+vi + V2) 



A_ - A+ V A+ (A_vi - V2) + A_ (A+vi + V2) e^-^'-'' 



(62) 



(63) 
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The control variables Vi and V2 are bounded respectively by K^axCi and C2 and we obtain that the components 

of the vector / e'^*^'^'^^i7 (5)^5 are bounded componentwise by 
Jo 



A, 



I A- 1 
C2 



3 J 

By taking k\ = ^^^2' S^*^ A-| 
defined in ([10]) by 



— — and A- 
4 



/ 1 



|A- 
3^ 
4 



(64) 



. We can bound the components of the vector 



v 



^maxC\ ~l~ _ , C2 
3k2 

16 

3k2 



(65) 



Equation ([38]) can be deduced directly from Equations ( [60j ) and ( [65] ). Moreover, since A is Hurwitz, we 
arrive to ([39|). 



E. Proof of Lemma ni.lO\ 



M 



The terms |t](^| and ^2"^ are clearly dominated by — ((^ +77 ). 

In ([41]), one has M(TLK-^Cia(yi))^ < CM (Cia(yi))^, which is dominated by ^^jicr(ji) if C/3Ci < 
The latter clearly holds true for ^2 large enough. 

We have M{TLC2o{y2)f < CM{C2o{y2)) , which is dominated by C2y2<7(j2)/4 if AMCj < C2/4. The 

latter is true according to the choice of C2 in (|24]). 

' — ' ]c C C 

We now turn to the control of the term k2Ci\y2Kr(7{yi)\ by jiO'(ji) + ^}'20'(}'2)- If |j2| > 1, the 

C2 , , 

second term is in control if — > Ck2Ci which holds true. Assume now that |j2| < 1- In the case where 

kiCi 

\yi \ > 1, the first term is in control if — - — > Ck2Ci which obviously holds true. It remains the case where 



4 

< 1. It is immediate to check that the quadratic form 



^^^Ji + ^^2 ~" ^^2^1 J 1^2 is definite positive. 
C 



We next consider the term ^i|j2||'^| • To control it, we first bound |(^| by for t large enough. In case 

k'^ 

C2 

\y2\ > I5 then the term is immediately dominated by -^b2|- Otherwise, one has, for ^2 large enough. 



^ib2||^P<c 



MM<c(^ + ^), 

^2 ^2 ^2 ^2 



C2 

the last two terms being controlled by — 1);2| ~^ ■ 

C 2 
Using again the estimate |(^ | by ^ for t large enough, the control of fci |yi 1 | reduces to that of /r2|yi'^ I- 

2 

It therefore remain to control the latter. This is where we need the hypothesis that y ^Yi^^. Assume first that 



one wants to get the inequality 



(66) 



20 



, , c 

This holds true if > On the other hand, if one wants to get the inequality 



k2\y\E, \ < — y2cr(j2), 



(67) 



C 



it holds if |j2| > ~rp}- case, outside F^j, one of the two inequalities ([66]) or ( [67] ) must hold true and 

2 

Lemm dllLlOl is established. 

Finally, with the choice of M = /3fc2 together with ([37]), it is immediate to verfy that V is positive definite. 
Moreover, we get 



k2 k2 



(68) 



for some positive constants a,-, di, 1 < i <3. 
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